float64 epsilon
float64 c
float64 k
float64 q
float64 yaw
float64 omega
float64 omega_a
float64 dis
float64 v
float64 v_a